#include "aruco_location/aruco_location.hpp"

int main(int argc, char** argv)
{   
    ros::init(argc, argv, "aruco_node");
    ros::NodeHandle n;
    std::string config_path;
    
    // config_path = "/home/lin/test_ws/src/aruco_location/config/param.yaml";
    n.getParam("config_path", config_path);
    n.param<std::string>("config_path", config_path, "src/aruco_location/config/location.yaml");
    
    aruco_location::readParameters(config_path);
    auto aruco_node = std::make_shared<aruco_location::ArucoLocation>(config_path);
    
    ros::spin();
    return 0;
}